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Die f olgenden Angaben sind den vom Anmelder oingereichten Unterlagen entnommen 

@ Einstellung von Sensoren rriit dem Geschwindigkeitsvektor 

@ Verfahren zur Berechnung der Systemgrofcen Ort, 
Kurswinkel und Geschwindigkeit eines Fahrzeuges mit- 
tels eines unabhangigen Navigationssystems sowie eines 
bordeigenen Navigationssystems, wobei das bordeigene 
Navigationssystem einen Geschwindigkeitssensor und g 
einen Beschleunigungssensor, insbesondere ein inertia- 
les Kreiselsystem, aufweist und wobei die von beiden Na- 
vigationssystemen ermittelteh System gro Ben einem Fil- 
termodul zugefuhrt werden, das Korrekturwerte fur die 
SystemgroSen und Korrekturwerte fur die Parameter der 
Fehlermodelle des bordeigenen Navigationssystems er- 
mittelt, wobei die von beiden Navigationssystemen er- 
mittelten Systemgrofcen in mindestens zwei Vektoren ge- 
trennt werden und jeder Vektor einem eigenen Filtermo- 
dul zugefuhrt wird und wobei das bordeigene Navigati- 
onssystem den Geschwindigkeitsvektor im Ref ere nzkoor- , 

dinatensystem ermittelt und dieser zusammen mit den — T ^-TSl 

vom unabhangigen Navigationssystem ermittelten Ge- 
\ schwindigkeitskomponenten einem ersten Filtermodul 
zur Kalibration des bordautonomen Geschwindigkeits- 
sensors zugefuhrt werden. 
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Beschreibung 



• Die Erfindung betrifft ein Verfahren zur Berechnung der 
SystemgroBen Ort, Kurswinkel und Geschwindigkeit eines 
Fahrzeuges mittels eines unabhangigen Navigationssy stems 5 
sowie eines bordeigenen Navigationssy stems, wobei das 
bordeigene Navigationssystem einen Geschwindigkeitssen- 
sor und einen Beschleunigungssensor, insbesondere ein 
inertiales Kreiselsystem, aufweist und wobei die von beiden 
Navigationssystemen ennittelten SystemgroBen einem Fil- 10 
termodul zugefuhrt werden, das Korrekturwerte fur die Sy- 
stemgroBen und Korrekturwerte fur die Parameter der Feh- 
Lermodelle des bordeigenen Navigationssystems ermittelt. 

Es ist bekannt, Fahrzeuge zu Land, zu Wasser und in der 
Luft mit Navigationssystemen auszuriisten, wobei zwischen 15 
bordeigenen Koppel-Navigationssystemen und unabhangi- 
gen Navigationssystemen, wie satelliten- oder funkgestutz- 
ten Systemen zu unterscheiden ist. Wahrend die bordeige- 
nen Sy steme ihre SystemgroBen anhand der Anderung von 
MeBwerten im fahrzeugfesten Bezugssystem ermitteln und 20 
die Anderungen zur aktuellen GroBe integrieren (koppeln), 
liefern die unabhangigen Navigationssysteme einen Satz 
von Navigationsdaten u. a. SystemgroBen aufgrund von 
empfangenen Signalen, die im Referenzsystem ausgesendet 
werden. Beiden Arten von Navigationssystemen sind sy- 25 
stembedingte Ungenauigkeiten der Ergebnisse immanent. 

Um die Genauigkeit der errnittelten SystemgroBen zu ver- 
bessern ist es bekannt, jeweils ein Navigationssystem der er- 
sten Art mit einem der zweiten Art zu kombinieren. So kon- 
nen z. B. die von einem Koppelnavigationssystem stam- 30 
menden Werte mit den entsprechenden Werten eines Satelli- 
ten-Navigationssystems (GPS; global positioning system) 
korrigiert werden. Dabei werden die Unzuianglichkeiten 
beider Sy steme gemindert. Die Korrektur der Koppetnavi- 
gationssysteme geschieht dabei anhand der externen unab- 35 
hangig bestimmten Schatzwerte, die einem zentralen Opti- 
malfilter, z. B. einem Kalrnan-Filters, zugefuhrt werden. 
Diesem Optimalfilter liegt ein lineares Gesamtfehlermodell 
zugrunde. 

Nachteilig an dem bekannten Verfahren zur Korrektur der 40 
Werte der errnittelten ZustandsgrbBen ist, daB alle denkba- 
ren Korrelationen innerhalb der modellierten Fehler der 
Koppelnavigation und der bordeigenen Sensoren beruck- 
sichtigt werden, was einen hohen Rechenaufwand und Spei- 
cherbedarf bedingt. Da das zentralisierte Optimalfilter auf 45 
einem linearen Fehlermodell basiert, miissen die Differen- 
zen zwischen den Parametern der Koppelnavigation und den 
Ergebnissen des unabhangigen Navigationssystems inner- 
halb 'des linearen Parameterraums liegen um nicht zu unsin- 
nigen Ergebnissen zu fiihreri. Somit ist ein hoher Aufwand 50 
beziiglich der Entwicklung und der Analyse von Steuerbar- 
keit, Storbarkeit, Beobachtbarkeit und Pararneterfestlegung 
notig. Insgesamt geht die Einrichtung des Systems mit ei- 
nem hohen Testaufwand und damit hohen Kosten einher. 

Aufgabe der vorliegenden Erfindung ist es daher, ein Ver- 55 
fahren bereitzustellen, das bei vergleichbarer Genauigkeit 
mit geringerem Rechenaufwand einhergeht und das daher 
zur Verringerung der Bereitstellungskosten beitragt. 

Diese Aufgaben werden durch das Verfahren nach An- 
spruch 1 gelbst. 60 

Das erfindungsgemaBe Verfahren kalibriert die mit einem 
systematischen Fehler behafteten Messungen der bordeige- 
nen fiir die Koppelnavigation benotigten Sensoren anhand 
von unabhangigen und lediglich beschrankt verfugbaren 
Messungen des Geschwindigkeit svektors automatisch, ge- 65 
nau und besonders zuverlassig. Dazu werden lediglich ein. 
unabhangiges z. B. ein satellitengestulzt.es Navigationssy- 
stem, das den Geschwindigkeitsvektor im fahrzeugfesten 



Koordinatensystem erfafit, sowie ein bordeigenes Navigati- 
onssystem, das den Geschwindigkeitsvektor und die Ande- 
rung des Kurswinkels im erdbezogenen Referenzkoordina- 
tensystem erfafit, benotigt. Dabei weist das bordeigene Na- 
vigationssystem einen Geschwindigkeitssensor und einen 
Beschleunigungssensor, z. B. ein inertiales Kreiselsystem, 
auf. 

Zudem kommt zur Durchfuhrung des Verfahrens ein Re- 
chenmodul zum Einsatz, das die MeBsignale des bordeige- 
nen Geschwindigkeitssensors und des Kurskreiselsystems 
liest und skaliert, sowie deren Fehlerkorrektur anhand eines 
Fehlermodells fur den jeweiligen Sensor berechnet Das Re- 
chenmodul ubernimmt zudem die fortlaufende Integration 
des Kurswinkels und fuhrt die Mechanisierungsgleichungen 
der Koppelortung durch. Dem Rechenrnodul werden auBer- 
dem die von dem autonomen Navigationssystem errnittelten 
Werte fur die SystemgroBen zugefuhrt. Das Rechenrnodul 
ubernimmt anhand von Filtermodulen (Optimalfiltem) Kor- 
rekturen fur die Parameter der Fehlermodelle fur das bord- 
eigene Koppelnavigationssystem und stabilisiert den Kurs- 
winkel. 

Besonders vorteilhaft an dem erfindungsgemaBen Verfah- 
ren ist, daB es kein zentralisiertes Optimalfilter benotigt, das 
alle bestehenden und miteinander korrelierten Systemzu- 
stande des Koppelnavigationssystems beriicksichtigen muB, 
sondern daB durch die dezentrale Architektur der Filtermo- 
dule weniger relevante Abhangigkeiten zwischen den Zu- 
standsgroBen fur die Berechnung ausgeschlossen werden 
konnen. Damit ist gegeniiber der zentralisierten Architektur 
ein significant kleinerer Rechenaufwand und Speicherbe- 
darf notig, so daB das Verfahren von vergleichsweise klei- 
nen und preisgiinstigen Rechenmodulen bewerkstelligt wer- 
den kann. Das mit dem erfindungsgemaBen Verfahren arbei- 
tende Navigationssystem ist zudem robust gegenuber Sy- 
stemstorungen und Parameteranderungen, da es die Storun- 
gen schneller erfafit als ein zentrales Filter. 

Da bei der Berechnung von ZustandsgroBen nur auf die 
zu vemachlassigenden Korrelationen zwischen den Zu- 
standsgroBen verzichtet wird, geht die erfindungsgemaBe 
dezentrale Architektur der Filter lediglich mit einer unbe- 
deutenden EinbuBe an Genauigkeit einher. Wegen der gerin- 
geren Storanfalligkeit erfordert das erfindungsgemaBe Ver- 
fahren aufierdem einen wesentlich geringeren Analyse-, 
Synthese- und Testaufwand. 

In einer besonders vorteilhaften Ausfiihrungsform des er- 
findungsgemaBen Verfahrens ist ein Filterrnodul fiir die Ka- 
libration des bordautonomen Geschwindigkeitssensors, ei- 
nes fur die Korrektur des inertialen Kurskreiselsystems und 
eines fiir die Korrektur des gekoppelten Ortes vorgesehen. 
Durch die Dezentralisierung der Filtermodule vergroBert 
sich die Toleranz und damit der Arbeitsbereich des Naviga- 
tionssystems. Es kalibriert sich trotz der Eingabe ungenauer 
Startparameter selber und ermoglicht damit den Einsatz ein- 
facher und weniger genauer Komponenten insbesondere bil- 
ligerer Kreisel. 

Das erfindungsgemaBe Verfahren lafit sich fur beliebige 
Zwecke einsetzen. Da es sich durch groBe Robustheit und 
Zuverlassigkeit auszeichnet, ist das erfindungsgemaBe Ver- 
fahren besonders geeignet fur den Einsatz in gestutzten 
Koppelnavigationssysteme von Landfahrzeugen, Flugzeu- 
gen und SchifTen. In jedem Einsatzgebiet liefert es beson- 
ders genaue Schatzergebnisse der Systemzustande. Es ist 
auch vorteilhaft, daB die Kalibration der bordautonomen 
Sensoren anhand von dezentralisierten, den Sensoren extra 
zugewiesenen Optimalfiltem fortlaufend erfolgt. Zur Durch- 
fuhrung des Verfahrens werden keine Vorkenntnisse uber 
Nahrungs werte der Kalibrationsparameter benotigt. Wegen 
der standigen Korrektur konnen vergleichsweise billige und 
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einfache auf dem Markt erhaltliche Sensoren verwendet 
werden. 

In dem beschriebenen Ausfuhrungsbeispiel werden fur 
das Kurskreiselsystem einfache Kreisel und Beschleuni- 
gungsmesser verwendet, welche die inertialen Drehdaten 
und spezifischen Krafte um bzw. entlang der Koordinaten- 
achsen des fahrzeugfesten oder eines Referenzkoordinaten- 
systems messen. Das Verfahren laBt sich jedoch auch mil 
beliebigen Kurskreiselsystemen durchflihren. So ist es mog- 
lich, drei orthogonal angeordnete Kreisel und Beschleuni- 
gungsmesser fahrzeugfest montiert ("Strapdown-System") 
oder auf einer Plattform raumfest stabilisiert ("Plattformsy- 
stern") zu verwenden. Weiterhin ist es denkbar, daB ein Krei- 
sel und zwei Beschleunigungsmesser fahrzeugfest rnontiert 
mit MeBachsen um die Fahrzeughochachse bzw. endang der 
Fahrzeuglangs- und Fahrzeugquerachse oder ein fahrzeug- 
fest montierter Kreisel mit der MeBachse um die Hochachse 
und mit a priori Kenntnissen uber die im Mittel wahrend der 
Mission auftretenden Lagewinkel eingesetzt wird. Als alter- 
native Ausfuhrungsform kann ein pendelnd aufgehangter 
Kurskreisel mit der MeBachse um die lokale Lotlinie entwe- 
der mit elektrischen, optischen oder mechanischen (Be- 
schleunigungsmesser) Vorrichtungen zur Bestimmung der 
Lagewinkel oder mit a-priori-Kenntnissen uber die im Mit- 
tel wahrend der Mission auftretenden Lagewinkel eingesetzt 
werden. 

Als Geschwindigkeitssensor kann ein Radsensor (Odo- 
meter) eingesetzt werden. Je nach den im Fahrzeug vorlie- 
genden Bedingungen konnen auch ein-, zwei- oder dreiach- 
sige nach dem Dopplerprinzip arbeitende Geschwindig- 
keitssensoren zum Einsatz kommen. Ebenso konnen Senso- 
ren beniitzt werden, welche die Geschwindigkeit relativ zur 
Luftstromung ("True Airspeed Sensor") oder relativ zur 
Wasserstromung (Logge) messen. Bei solchen Sensoren 
konnen eventuell fehlende MeBachsen durch a priori Kennt- 
nisse iiber die im Mittel wahrend der Fahrt auftretenden Si- 
gnale ersetzt werden. 

Fiir das unabhangige Navigationssystem neben dem er- 
wahnten "Global Positioning System" als satellitengestutz- 
tem System auch Gerate zur terrestrischen Funknavigation, 
Sy steme, die auf Daten von Karten zugreifen oder eine 
Kombination dieser Sy steme verwendet werden. 

Im folgenden wird das Verfahren anhand der Fig. 1 und 2 
erklart. Dabei zeigen 

Fig. 1 die dezentralisierte Architektur eines gestiitzten 
Koppelnavigationssys terns und 

Fig. 2 ein kalibriertes Kpppelnavigationssystem. 

In Fig. 1 ist der erfindungsgemaBe Verfahrensablauf in ei- 
nem Schaubild dargestellt. Es handelt sich bei dieser beson- 
deren Ausfuhrungsform um ein Verfahren zur Berechnung 
der drei SystemgroBen Ort, Kurswinkel und Geschwindig- 
keit eines Fahrzeuges. Dazu wird ein unabhangiges Naviga- 
tionssystem 1, in diesem Falle ein "Global Positioning Sy- 
stem", das als unabhangiger Orts-(Positions-) und Ge- 
schwindigkeitssensor die SystemgroBen im Referenzkoordi- 
natensystem, d. h. relativ zur Umgebung miBt. Zudem ist in 
Fig. 1 ein bordeigenes Navigationssystem, das einen bord- 
eigenen Geschwindigkeitssensor 2 und einen bordeigenen 
Beschleunigungssensor 3, in diesem Fall ein inertiales Krei- 
selsystem, aufweist. Mit dem unabhangigen Navigationssy- 
stem 1 wird das bordeigene Navigationssystem unterstulzt. 
Aus den von bei den- Systemen ausgegebenen Wcrtcn wird 
dann der Zu stands vektor des Fahrzeugs als optimaler 
Schatzwert. ermittelt. 

Wie in Fig. 1 dargestellt, werden die MeBsignale des iner- 
tialen Kreiselsystems 3 einem Algorithmus 4 zugefiihrt. mit 
dem die MeBwerte so skaliert und anhand eines Fehlernio- 
dells fiir das Kreiselsystem verbessert. werden, daB Zahlen- 



werte fiir die Kurswinkelanderung und die Lagewinkel als 
Ausgangsgrofien vorliegen. In Abhangigkeit der Ausfuh- 
rungsform des Kurskreiselsystems 3 nutzt der Algorithmus 
4 die iiber den Eingang 5 riickgefuhrten Parameter Ort, Ge- 

5 schwindigkeitsvektor und Kurswinkel. Die ermittelten An- 
derungen des Kurswinkels werden einem Integrator 6 zuge- 
fiihrt, der die Integration der Anderungen zum aktuellen 
Kurswinkel aufsummiert. 

Die MeBsignale des bordeigenen Geschwindigkeitssen- 

10 sors 2 werden einem Algorithmus 8 zugefiihrt, der die MeB- 
werte skaliert und anhand eines Fehlermodells fur den Ge- 
schwindigkeitssensor 2 verbessert, so daB Zahlenwerte fiir 
den Geschwindigkeitsvektor im fahrzeugfesten Koordina- 
tensystem vorliegen. Als Geschwindigkeitssensor 2 kann 

15 ein Radsensor (Odometer) eingesetzt werden, der endang 
der Fahrzeuglangsachse ein zur momentanen Geschwindig- 
keit proportionales integriertes MeBsignal liefert und a 
priori Kenntnisse uber die im Mittel wahrend der Fahrt auf- 
tretenden Signale entlang der Fahrzeugquer- und Fahrzeug- 

20 hochachse enthalt. 

Die vom Algorithmus 8 skalierten MeBsignale, die einen 
Geschwindigkeitsvektor im fahrzeugfesten Koordinatensy- 
stem bilden, werden in einem weiteren Verfahrensschritt ei- 
nem Block von Mechanisierungsgleichungen 9 der Koppel- 

25 ortung zugefuhrt. Die Mechanisierungsgleichungen 9 be- 
rechnen den gekoppelten Ort und den Geschwindigkeitsvek- 
tor im Referenzkoordinatensystem unter Einbeziehung des 
integrierten Kurswinkels 10 und des Geschwindigkeitsvek- 
tors 11 und des Lagewinkels 7. 

30 Dem Algorithmus 8 werden zur Kalibrierung des bord- 
eigenen Geschwindigkeitssensors von einem dezentralisier- 
ten Filtermodul 12 (Optimalfilter) Korrekturen fur die Para- 
meter seines Fehlermodells zugefuhrt 13. Aufgabe des Fil- 
terrnoduls 12 ist die Korrekturen zu berechnen und bereitzu- 

35 stellen. Dazu erhalt das Filtermodul den von den Mechani- 
sierungsgleichungen 9 der Koppelortung berechneten Ge- 
schwindigkeitsvektor im Referenzkoordinatensystem 14 
und die vom unabhangigen Navigationssystem 1 ermittelten 
horizontalen und vertikalen Geschwindigkeitskomponenten 

40 15. 

Der Algorithmus 4 bekommt fiir die Kalibrierung des 
inertialen Kurskreiselsystems Korrekturen 16 fiir die Para- 
meter seines Fehlermodells. Diese Korrekturen werden von 
einem zweiten dezentralen Filtermodul 17 (Opdmalfilter) 

45 ermittelt, des sen Aufgabe die Berechnung und Bereitstel- 
lung dieser Korrekturen ist. Als EingangsgroBe erhalt das 
Filtermodul 17 den im Integrator 6 berechneten Kurswinkel 
10 und die vom unabhangigen Navigationssystem 1 ermit- 
telten Kurs- und Spurwinkel 19 Das Filtermodul 17 gibt 

50 dem Integrator eine Kurswinkelkorrektur 23 zuruck. 

Neben der Kalibrierung des bordeigenen Kurskreiselsy- 
stems 3 und des Geschwindigkeitssensors 2 ermoglicht der 
vom unabhangigen Navigationssystem 1 bestimmten Ort 
auch eine Unterstutzung 20 der Berechnung des Ortes durch 

55 das bordeigene Navigationssystem. Dazu wird ein drittes 
Filtermodul 21 zu Positionsstutzung bereitgestellt, das den 
vom unabhangigen Navigationssystem 1 bestimmten Ort 
und mit dem von den Mechanisierungsgleichungen 9 be- 
rechneten Ort 18 vergleicht. In Abhangigkeit von der DirTe- 

60 renz dieser GroBen ermittelt das Filtermodul 21 Ortskorrek- 
turen 22, die den Mechanisierungsgleichungen 9 zur Kor- 
rektur des Ortes zugefuhrt werden. 

Wie dargelegt, werden die die von beiden Navigationssy- 
sternen 1 und 2 ermittelten SystemgroBen in drei Vektoren 

65 (Geschwindigkeit 24, integrierte Position 25 und integrierter 
Kurswinkel 26) getrennt, und jeder Vektor wird einem eige- 
nen Filtermodul zugefuhrt. 

Mit dem vorbeschriebenen Verfahren wird ein kalibriertes 
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Koppelnavigationssystem geschafFen, wie es in Fig, 2 dar- 
gestellt ist. Dieses enthalt den Algorithmus 4a zur Skalie- 
rung der MeBwerte und zur Fehlerkorrektur anhand eines 
verbesserten Fehlermodells fiir das Kurskreiselsystem so- 
wie den Algorithmus 8a zur Skalierung der MeBwerte und 5 
zur Fehlerkorrektur anhand eines verbesserten Fehlermo- 
dells fiir den bordeigenen Geschwindigkeitssensor Der Al- 
gorithmus 4a ermittelt genaue Kurswinkelanderungen, die 
es dem Integrator 6 ermoglichen, den Mechanisierungsglei- 
chungen 9 genaue integrierte Kurswinkel zuzufuhren. 10 

Zusammen mit den Lagewinkeln und den vom Algorith- 
mus 8a ausgegebenen genauen Geschwindigkeitsvektoren 
im fahrzeugfesten Koordinatensystem berechnen die Me- 
chanisierungsgleichungen 9 genaue Geschwindigkeitsvek- 
toren im Referenzkoordinatensystem sowie den Ort, der 15 
dem vom unabhangigen Navigationssystem 1 ermittelten 
Ort angenahrt ist. 



net, daB das dritte Filtermodul (21) Korrekturen zur 
Berechnung des Ortes bereitstellt, 
8. Verfahren nach einem der vorherigen Anspriiche, 
dadurch gekennzeichnet, daB die Kalibration der bord- 
eigenen Sensoren fortlaufend erfolgt. 



Hierzu 2 Seite(n) Zeichnungen 



Patentanspriiche - 

20 

1. Verfahren zur Berechnung der SystemgroBen Ort, 
Kurswinkel und Geschwindigkeit eines Fahrzeuges 
mittels eines unabhangigen Navigationssystems sowie 
eines bordeigenen Navigationssystems, wobei das 
bordeigene Navigationssystem einen Geschwindig- 25 
keitssensor und einen Beschleunigungssensor, insbe- 
sondere ein inertiales Kreiselsystem, aufweist und wo- 
bei die von beiden Navigationssystemen ermittelten 
SystemgroBen einem Filtermodul zugefuhrt werden, 
das Korrekturwerte fiir die SystemgroBen und Korrek- 30 
turwerte fur die Parameter der Fehlermodelle des bord- 
eigenen Navigationssystems ermittelt, dadurch ge- 
kennzeichnet, daB die von beiden Navigationssyste- 
men (1, 2, 3) ermittelten SystemgroBen in mindestens 
zwei Vektoren getrennt werden und jeder Vektor einem 35 
eigenen Filtermodul (12, 17, 21) zugefuhrt wird. 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, daB das bordeigene Navigationssystem (2) den Ge- 
schwindigkeitsvektor im Referenzkoordinatensystem 
ermittelt und dieser zusammen mit den vom unabhan- 40 
gigen Navigationssystem (1) ermittelten Geschwindig- 
keitskomponenten einem ersten Filtermodul (12) zur 
Kalibration des bordautonomen Geschwindigkeitssen- 
sors zugefuhrt werden. 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 45 
net, daB das erste Filtermodul (12) Korrekturen fiir die 
Parameter des Fehlermodells des bordeigenen Ge- 
schwindigkeitssensors bereitstellt. 

4. Verfahren nach einem der vorherigen Anspriiche, 
dadurch gekennzeichnet, daB das bordeigene Navigati- 50 
ons system (3) den integrierten Kurswinkel im Refe- 
renzkoordinatensystem ermittelt und dieser zusammen 
mit den vom unabhangigen Navigationssystem (1) er- 
mittelten Kurswinkel einem zweiten Filtermodul (17) 
zur Kalibration des bordautonomen Beschleunigungs- 55 
sensors zugefuhrt werden. 

5. Verfahren nach Anspruch 4, dadurch gekennzeich- 
net, daB das zweite Filtermodul (17) Korrekturen fur 
die Parameter des Fehlermodells des bordeigenen Be- 
schleunigungssensors bereitstellt. 60 

6. Verfahren nach einem der vorherigen Anspruche, 
dadurch gekennzeichnet, daB das bordeigene Navigati- . 
onssystem den integrierten Ort im Referenzkoordina- 
tensystem ermittelt und dieser zusammen mit den vom 
unabhangigen Navigationssystem ermittelten Ort ei- 65 
nem dritten Filtcnnodul (21) zur Korrektur der Ortsko- 
ordinaten zugefuhrt werden. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
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